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DETERMINE POSITION AND ORIENTATION OF NEXT TIME'S GAIT SUPPORTING LEG 
COORDINATE SYSTEM SO THAT POSITION OF REPRESENTATIVE POINT OF NEXT 
TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM IS P CO AND DIRECTION OF 
X-AXIS OF NEXT TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM IS 

ORIENTATION OF LINE SEGMENT P (0) Q CO) 

S3506 

DETERMINE NEXT TIME'S SHORT-TERM DESIRED POINT Q CD BASED ON 
REPRESENTATIVE POINT PCD OF NEXT TIME'S GAIT SUPPORTING LEG 

COORDINATE SYSTEM AND DESIRED PATH 

S3508 

DETERMINE REPRESENTATIVE POINT PC2)0F NEXT BUT ONE TIME'S GAIT 
SUPPORTING LEG COORDINATE SYSTEM ON LINE SEGMENT P CO Q CO SO AS | 
NOT TO EXCEED ALLOWABLE LANDING RANGE CSELF-DEPENDENT ALLOWABLE 

LANDING POSITION RANGE) 

, S35T0 

DETERMINE POSITION AND ORIENTATION OF NEXT BUT ONE TIME'S GAIT 
SUPPORTING LEG COORDINATE SYSTEM SO THAT POSITION OF REPRESENTATIVE 
POINT OF NEXT BUT ONE TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM 
IS P C2) AND DIRECTION OF X-AXIS OF NEXT BUT ONE TIME'S GAIT j 
SUPPORTING LEG COORDINATE SYSTEM IS ORIENTATION OF LINE SEGMENT 
PCOQCO 
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FIG. 28 
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S3600 


SET FIRST TURNING GAIT DETERMINED IN UST CONTROL PERIOD AS I 
CURRENT TIME'S GAIT, AND SECOND TURNING GAIT AS NEXT TIME'S GAIT I 


S3602 


CALCULATE PREDICTED NEXT TIMES LANDING POSITION/POSTURE AND 
PREDICTED NEXT BUT ONE TIME'S LANDING POSITION/POSTURE BASED ON 
ESTIMATED SUPPORTING LEG COORDINATE SYSTEM, AND CURRENT TIME'S 
DESIRED GAIT AND NEXT TIME'S DESIRED GAIT 


S3604 


CALCULATE PREDICTED NEXT TIME'S LANDING POSITION DEVIATION AND 
PREDICTED NEXT TIME'S LANDING ORIENTATION DEVIATION, WHICH ARE 
POSITIONAL DEIVATION AND ORIENTATIONAL DEVIATION ROM DESIRED 
PATH OF PREDICTED NEXT TIME'S LANDING POSITION/POSTURE 


1 S3606 


CALCULATE PREDICTED NEXT BUT ONE TIME'S LANDING POSITION 
UtvlAHUN ANU rKLUIUtU NcXI BUI ONE TIME i LANDING ORIENTATION 
DEVIATION, WHICH ARE POSITIONAL DEIVATION AND ORIENTATIONAL 
DEVIATION FROM PATH OF PREDICTED NEXT BUT ONE TIME'S LANDING 
POSITION/POSTURE 


S3608 


CORRECT POSITION AND ORIENTATION OF NEXT TIME'S GAIT SUPPORTING 
LEG COORDINATE SYSTEM AND POSITION AND ORIENTATION OF 
NEXT BUT ONE TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM 
BASED ON ABOVE DEVIATION 
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FIG. 29 
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NEXT TIME'S 
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DESIRED PATH 



PREDICTED NEXT 
BUT ONE TIME'S 
LANDING POSITION 



DESIRED PATH 

(DESIRED 
FOOTSTEP PATH) 
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LANDING 

POSITION 

DEVIATION 



CURRENT TIME'S 
LANDING POSITION 
DEVIATION 



PREDICTED NEXT 
BUT ONE TIME'S 
LANDING ORIENTATION 
DEVIATION 

PREDICTED NEXT BUT ONE TIME'S 
LANDING POSITION/POSTURE 
(PREDICTED NEXT BUT ONE TIME'S GAIT 
SUPPORTING LEG COORDINATE SYSTEM) 

(PREDICTED LANDING POSITION OF 
NEXT TIME'S GAIT) 
PREDICTED NEXT TIME'S 
LANDING ORIENTATION 
DEVIATION 

PREDICTED NEXT TIME'S 
LANDING POSITION/POSTURE 

(PREDICTED NEXT TIME'S GAIT 
SUPPORTING LEG COORDINATE SYSTEM) 

(PREDICTED LANDING POSITION OF 
CURRENT TIME'S GAIT) 
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FIG. 30 
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[_ S3700 

*" DETERMINE DEVIATION e BY WHICH DESIRED ZMP 
EXCEEDS ALLOWABLE RANGE 



S3702 

CORRECT POSITION OF NEXT TIME'S GAIT SUPPORTING LEG 
COORDINATE SYSTEM AND POSITION OF NEXT BUT ONE 
TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM BY Ka*e 
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FIG. 31 

C ENTRY ^ 

I S3800 

DETERMINE ENVIRONMENT-DEPENDENT NEXT TIME'S LANDING 
POSITION/ORIENTATION ALLOWABLE RANGE AND 
ENVIRONMENT-DEPENDENT NEXT BUT ONE TIME'S LANDING 

POSITION/ORIENTATION ALLOWABLE RANGE 

S3802 

DETERMINE POSITION AND ORIENTATION OF NEXT TIME'S GAIT SUPPORTING 
LEG COORDINATE SYSTEM AND POSITION AND ORIENTATION OF NEXT BUT 
ONE TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM SO AS TO 
SATISFY ALL OF ENVIRONMENT-DEPENDENT NEXT TIME'S LANDING 
POSITION/ORIENTATION ALLOWABLE RANGE, ENVIRONMENT-DEPENDENT NEXT 
BUT ONE TIME'S LANDING POSITION/ORIENTATION ALLOWABLE RANGE, AND 
SELF-DEPENDENT LANDING POSITION/POSTURE ALLOWABLE RANGE 
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FIG. 32 
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S3850 



DERTERMINE NEXT TIME'S LADNING POSITION/ORIENTATION 
(POSITION/ORIENTATION OF NEXT TIME'S GAIT SUPPORTING LEG COORDINATE 
SYSTEM) WITHIN ENVIRONMENT-DEPENDENT NEXT TIME'S LANDING POSITION/ 
ORIENTATION ALLOWABLE RANGE AND SELF-DEPENDENT ALLOWABLE LANDING 
RANGE 



S3852 



DETERMINE SELF-DEPENDENT ALLOWABLE LANDING RANGE FOR NEXT BUT ONE 
TIME'S LANDING POSITION/ORIENTATION BASED ON NEXT TIME'S LANDING 
POSITION/ORIENTATION 



S3854 



YES 



S3856 



IS THERE COMMON REGION OF 
SELF-DEPENDENT ALLOWABLE 
LANDING RANGE FOR NEXT BUT 
ONE TIME'S LANDING POSITION/ 
ORIENTATION AND ENVIRONMENT- 
DEPENDENT NEXT BUT ONE 
TIME'S LANDING POSITION/ 
ORIENTATION ALLOWABLE RANGE? 




DETERMINE NEXT BUT ONE TIME'S 
LANDING POSITION/ORIENTATION WITHIN 
COMMON REGION (AS CENTRALLY IN 
COMMON REGION AS POSSIBLE) 



S3858 



C RETURN ) 



CORRECT NEXT TIME'S LANDING POSITION 
AND/OR ORIENTATION IN ORDER TO 
CAUSE SELF-DEPENDENT ALLOWABLE RANGE 
FOR NEXT BUT ONE TIME'S LANDING 
POSITION/ORIENTATION TO APPROACH 
ENVIRONMENT-DEPENDENT NEXT TIME'S 
LANDING POSITION/ORIENTATION 
ALLOWABLE RANGE 



$3860 
GO TO A | 
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FIG. 34 



ENVIRONMENT-DEPENDENT 
NEXT BUT ONE TIME'S LANDING 
POSITION/ORIENTATION 
NEXT TIME'S ^ABLERANGE 
LANDING 

POSITION/ORIENTATION 
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ENVIRONMENT-DEPENDENT 
NEXT BUT ONE TIME'S LANDING 
POSITION/ORIENTATION 
NEXT TIME'S ALLOWABLE RANGE 
LANDING 

POSITION/ORIENTATION 




NEXT TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 



SELF-DEPENDENT 
ALLOWABLE 
LANDING RANGE 
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SUPPORTING LEG 1 
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SYSTEM 
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ALLOWABLE 
LANDING RANGE 
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FIG. 35 
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S3900 

DETERMINE DEVIATION e BY WHICH DESIRED ZMP 

EXCEEDS ALLOWABLE RANGE 

S3902 

CORREQ POSITION OF NEXT TIME'S GAIT SUPPORTING LEG 
COORDINATE SYSTEM AND POSITION OF NEXT BUT ONE 
TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM BY Ko*e 

S3904 

IF EITHER ONE OF ENVIRONMENT-DEPENDENT NEXT TIME'S 
! LANDING POSITION/ORIENTATION ALLOWABLE RANGE, 
ENVIRONMENT-DEPENDENT NEXT BUT ONE TIME'S LANDING 
POSITION/ORIENTATION ALLOWABLE RANGE, AND SELF-DEPENDENT 
LANDING ALLOWABLE RANGE IS NOT SATISFIED, 
CORRECT EITHER POSITION AND ORIENTATION OF NEXT TIME'S 
GAIT SUPPORTING LEG COORDINATE SYSTEM OR POSITION AND 
ORIENTATION OF NEXT BUT ONE TIME'S GAIT SUPPORTING LEG 
COORDINATE SYSTEM WITH MINIMUM CORRECTIVE QUANTITY 
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FIG. 36 



C START ) 



INITIALIZE (SUBSTITUTE CURRENT TIME'S SUPPORTING LEG COORDINATE 
SYSTEM FOR OTH SUPPORTING LEG COORDINATE SYSTEM, AND RESET 
PASSOMETER COUNTER nn TO 0) 



S4000 



DETRERMINE DESIRED PATH FROM DESTINATION AND MAP INFORMATION | S4002 



S4004 



oo 



TRAJECTORY GUIDANCE SUBROUTINE 



SUBROUTINE FOR DETERMINING GAIT PARAMETERS OF 
NORMAL GAIT 



SUBROUTINE FOR DETERMINING INITIAL STATE OF NORMAL 
GAIT (INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ 
VELOCITY, INITIAL BODY POSTURE ANGLE /ANGULAR VELOCITY) 



DETERMINE GAIT PARAMETERS OF CURRENT TIME'S GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE VERTICAL 
COMPONENT 



CURRENT TIME'S GAIT PARAMETER CORRECTING SUBROUTINE 
(CORRECT CURRENT TIME'S GAIT PARAMETERS TO EQUALIZE 
FINAL DIVERGENT COMPONENT OF CURRENT TIME'S GAIT 
TO INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT) 
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FIG. 37 
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